package Tests;
import OrangeController;
import lejos.nxt.Button;
import Controller.*;

public class TestDistance {
	
	private static OrangeController driveControl = new OrangeController();
	private static boolean done = false;
	
	//This test let's the robot drive 1 meter forward, stop, then 1 meter backward.
	 public static void main(String[] args)
	    {
		 while(!done)
		 {
		   System.out.println("Moving Forward");
		 	driveControl.forward(100);
		 	System.out.println("Moving Backward");
		 	driveControl.backward(100);	
		 	System.out.println("Stage Completed, press enter to run again");
		 	if(Button.waitForPress() == Button.ID_ENTER)
		 		done = false;
		 	else
		 		done = true;
		 		
		 	
		 }
	    }

}
